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This  paper  deals  with  time-optimal  control  for  the  row  guidance  system  of  an  autonomous  field  robot 
with  differential  drive.  The  movement  of  the  robot  is  concretely  constrained  by  the  plant  cultivation  envi¬ 
ronment.  A  time-optimal  differential  velocity  profile  is  generated  based  on  optimal  control  theory  to 
eliminate  any  initial  error  or  tracking  deviation.  To  allow  for  an  efficient  implementation  on  a  micro-pro¬ 
cessor,  a  substitute  controller  is  suggested  to  perform  the  minimum-time  guidance  task.  The  substitute 
with  a  cascade  structure  is  proposed  using  PID  algorithms.  The  computational  efficiency  is  consequently 
improved  and  the  system  is  more  convenient  to  be  carried  out  on  a  micro-processor.  The  performance  of 
the  proposed  substitute  system  is  investigated  through  numerical  studies  by  comparison  with  the  time- 
optimal  controller.  Experiments  are  comprehensively  conducted  indoors  and  outdoors  to  evaluate  the 
proposed  row  guidance  regime.  The  results  show  the  satisfactory  performance  and  efficiency  with  a  high 
precision  of  ±3  cm  in  the  field. 

©  2013  Elsevier  B.V.  All  rights  reserved. 


1.  Introduction 

In  the  past  decades,  autonomous  agricultural  machinery  has 
been  subjected  to  extensive  studies  due  to  labor  shortage,  food 
product  quality  and  safety,  as  well  as  the  environmental  impact. 
Automatic  harvesting  machines  were  extensively  studied  for 
cucumber  (Van  Henten  et  al.,  2003),  cherry  (Tanigaki  et  al.,  2008) 
and  white  asparagus  (Chatzimichali  et  al.,  2009).  Special  autono¬ 
mous  robots  were  also  suggested  for  greenhouse  applications  by 
Mehta  et  al.  (2008)  and  Sanchez-Hermosilla  et  al.  (2010).  A  number 
of  researchers  actively  investigated  automatic  machines  for  weed¬ 
ing  control  based  on  machine  vision  and  Real-time  Kinematic  Glo¬ 
bal  Positioning  Systems  (RTK  GPS).  Considerable  efforts  have  been 
made  by  Straten’s  group  based  on  machine-vision  and  RTK  GPS 
system  in  weeding  control  for  sugar  beet  (Bakker  et  al.,  2004, 
2011).  The  main  techniques  for  weeding  control  were  thoroughly 
summarized  by  Slaughter  et  al.  (2008).  Autonomous  differential- 
drive  wheeled  mobile  robots  are  able  to  track  almost  all  the  possi¬ 
ble  desired  paths,  and  have  been  widely  used  in  well  structured 
environment  such  as  factories,  warehouses  and  offices  (Diaz  del 
Rio  et  al.,  2001;  Feng  et  al.,  1993;  Gracia  and  Tornero,  2008).  In 
agricultural  applications,  differential-drive  wheeled  mobile  robots 
have  been  also  applied  as  platform  or  chassis  to  carry  the  associate 
apparatus  like  harvesting  robot  arm  or  spraying  pistol  for  weeds 
(Astrand  and  Baerveldt,  2002;  Mehta  et  al.,  2008;  Van  Henten 
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et  al.,  2003;  Xue  et  al.,  2012).  An  automated  row  guidance  control 
system  is  necessary  for  the  autonomous  agricultural  robots  to 
operate  within  rowed  crops  collision-freely  to  perform  various 
tasks.  Differently  from  the  well-structured  environment,  the  work¬ 
ing  environment  of  agricultural  robots  imposes  varied  constraints 
on  the  movements  of  the  vehicles  due  to  contact  surface  of  loose 
soil  and  the  specialties  of  crop  cultivation  features.  The  row  guid¬ 
ance  system  of  the  autonomous  agricultural  robots  is  expected  to 
be: 

-  Feasible:  efficient  and  easy  to  be  put  into  practice, 

-  Safe:  avoiding  dangerous  motions  and  collisions  with 
crops, 

-  High  precision  tracking:  to  operate  safely  within  limited 
working  space  between  rows, 

-  Low  computational  costs:  to  perform  the  real-time  fol¬ 
lowing  algorithms  on  a  single  chip. 

In  this  work  we  focus  on  the  development  and  implementation 
of  the  time-optimal  row  guidance  system  of  an  autonomous  field 
robot.  The  field  mobile  robot  was  developed  as  a  platform  for  white 
asparagus  harvesting.  In  contrast  to  the  most  often  reported  tech¬ 
nologies  in  row  identification  based  on  machine-vision  and  RTK 
GPS  which  were  summarized  by  Slaughter  et  al.  (2008),  the  posi¬ 
tion  of  the  target  row  for  this  robot  is  detected  using  sonar  sensors 
benefiting  from  the  erected  cultivation  bed.  The  up-erected  culti¬ 
vation  bed  of  white  asparagus  provides  a  natural  surface  for  the 
sonar  sensors.  This  design  not  only  relieves  the  computation  effort 
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of  the  processor  in  comparison  with  the  machine-vision  based 
application,  but  also  reduces  the  investment.  The  study  of  this 
work  is  done  based  on  our  previous  research  (Dong  et  al.,  2011). 
In  that  paper,  a  row  guidance  system  based  on  conventional  PID 
method  was  suggested  for  the  prior  try.  The  row  following  perfor¬ 
mance  was  verified  in  labor.  However,  since  the  robot  movement  is 
closely  constrained  by  its  working  environment,  the  initial  error 
and  following  deviation  are  expected  to  be  eliminated  as  quickly 
as  possible  to  achieve  a  stable  operation.  In  this  paper,  we  investi¬ 
gate  firstly  the  simulation  study  of  the  time-optimal  control  prob¬ 
lem  of  the  row  guidance  system.  Due  to  the  very  limited 
investment  in  the  machine’s  cost,  the  realization  of  the  time-opti¬ 
mal  control  is  not  feasible  on  a  current  micro-processor.  Finally,  we 
realize  the  guidance  performance  of  the  time-optimal  control  using 
a  practical  substitute  system  by  improving  the  previous  row  guid¬ 
ance  controller  based  on  PID  algorithms.  The  row  following  perfor¬ 
mance  of  the  substitute  system  is  extensively  evaluated  through 
comparison  with  the  results  of  time-optimal  control  system  in 
simulation  studies,  and  further  investigated  experimentally  in  lab¬ 
oratory  as  well  as  in  the  field. 

The  outline  of  this  paper  is  arranged  as  follows.  The  mechanical 
design  of  the  harvesting  robot  platform  is  described  in  the  follow¬ 
ing  Section  2.  In  Section  3  the  kinematic  model  of  the  robot  and  the 
environmental  constraints  are  introduced.  Section  4  is  devoted  to 
formulation  of  minimum  time  problem  and  controller  develop¬ 
ment.  Section  5  firstly  details  the  establishment  of  the  practical 
substitute  system  for  time-optimal  guidance  control,  and  then 
illustrates  the  outcome  of  simulation  and  experimental  tests.  The 
concluding  remarks  and  future  work  are  given  in  Section  6. 

2.  Mechanical  design 

The  agricultural  wheeled  mobile  robot  in  this  work  is  designed 
as  a  development  platform  of  an  autonomous  field  machine  for 
white  asparagus  harvesting.  White  asparagus  is  cultivated  in  paral¬ 
lel  trapezoidal  beds  that  are  heaped  up  about  60  cm  over  ground 
surface.  The  cultivation  beds  are  built  with  80  cm  intervals  and 
100  cm  wide  at  the  bottom.  The  heaped  beds  are  always  covered 
with  a  film  to  keep  the  soil  moisture  in  order  to  guarantee  the 
product’s  quality.  The  field  robot  is  demanded  to  operate  by 
striding  one  bed  at  a  time.  It  is  also  necessary  for  the  robot  to  have 
sufficient  place  for  the  harvested  white  asparagus  spears  for 
future  development.  The  platform  is  designed  for  both  efficiency 
and  cost  effectiveness.  The  dimensions  of  the  robot  base  is 
310  x  180  x  160  cm  ( l/w/h ).  The  platform  frame  has  a  hollow 
space  room  of  310  x  160  x  73  cm  (l/w/h)  under  the  machine.  It 
has  a  weight  of  450  kg  with  a  maximal  load  capacity  of  200  kg. 
The  vehicle  has  a  rolling  system  to  guarantee  mobility  and  maneu¬ 
verability  in  an  environment  with  considerable  disturbance.  The 
platform  has  two  drive  wheels  at  the  front  with  a  radius  of 
30  cm,  which  are  independently  actuated  by  two  DC  motors,  and 
two  casters  with  a  radius  of  15  cm  at  the  rear.  The  maximal  veloc¬ 
ity  of  the  vehicle  is  expected  50  cm/s  by  considering  the  upcoming 
development  of  harvesting  function.  A  450W  DC  motor 
(MY1020Z2,  Zhejiang  Unite  Electric  Motor  Co.,  Ltd.,  China)  was  se¬ 
lected  under  the  assumption  that  the  vehicle  travels  on  a  sandy 
surface  with  a  maximal  slope  of  5°.  Sabertooth  motor  driver 
(2  x  50  HV)  is  applied  to  actuate  both  motors.  The  drive  wheel  is 
connected  with  the  DC  motor  axis  through  a  second-order  chain 
gears  with  a  ratio  of  16:1  to  improve  the  drive  force  and  reduce 
the  revolution  speed.  Steering  is  accomplished  only  by  adjusting 
the  differential  velocities  of  the  front  drive  wheels.  Two  recharge¬ 
able  batteries  (121/3 SAH)  supply  power.  The  identification  of  the 
actual  position  of  the  mobile  robot  is  absolutely  essential  for  the 
autonomous  operation.  By  utilizing  the  features  of  the  cultivation 
bed,  two  ultrasonic  sensors  (Parallax  PING))))  with  an  angular 


aperture  of  43°  are  applied  to  measure  the  front  and  rear  side 
distances  between  robot  and  the  target  bed.  The  sensors  are  in¬ 
stalled  at  the  right  side  and  vertically  to  the  side  surface  of  the  cul¬ 
tivation  bed,  one  of  which  is  near  the  front  drive  wheel  and  the 
other  near  the  rear.  The  revolution  of  the  drive  motor  is  sensed 
using  an  incremental  optical  encoder  (Model  120E)  with  a  resolu¬ 
tion  of  128  pulses  per  revolution.  The  signals  of  the  sensors  are 
processed  by  a  PSoC  CY8C55  processor  on  PSoC  development  board 
(CY8CKIT-001,  Cypress  Semiconductor  Corporation,  USA). 

3.  Mathematic  model  and  environmental  constraints 

3.1.  Kinematics 

The  platform  of  the  differential  drive  agricultural  robot  is  as¬ 
sumed  to  consist  of  rigid  bodies  and  to  move  on  a  planar  surface. 
The  location  of  the  robot  (x,y)  is  represented  by  the  center  point 
P  of  the  front  axle  in  the  initial  coordinate  system.  6  is  the  orienta¬ 
tion  of  the  field  robot.  If  the  robot  operates  over  a  curvature  path 
with  an  instantaneous  angular  speed  co,  the  velocities  of  the  drive 
wheels  vL  and  vR  are  given  by: 

VL  =  V-jO)  (1) 

vR  =  v  +  lj(o  (2) 

where  Lb  denotes  the  base  distance  of  the  drive  wheels,  v  the  for¬ 
ward  velocity  of  the  robot  at  the  point  P.  It  is  also  assumed  that 
the  wheels  are  non-deformable  and  there  is  no  slip  between  wheels 
and  ground.  The  movement  of  the  machine  subjects  to  the  non- 
integrable  constraint 

-xsinO  +  ycos9  =  0  (3) 

In  the  initial  coordinate  system,  the  kinematic  model  of  the  field 
mobile  robot  is  stated  as: 

x  \  /  cos6  0  \ 

rir  ?p 

3.2.  Environmental  constraints 

The  machine  is  demanded  to  drive  by  striding  one  row  at  a  time 
(see  Fig.  1).  The  interval  space  (SB  =  80  cm)  between  cultivation 
beds  limits  the  robot  movement  on  both  lateral  offset  and  orienta¬ 
tion  angle.  The  location  of  the  robot  with  respect  to  its  target  row  is 
supervised  by  the  front  and  rear  side  distances  denoted  by  5/  and  Sr 
measured  by  the  installed  ultrasonic  sensors  SF  and  SR  (shown  in 
Fig.  1(a).  Because  of  the  symmetry  of  the  spatial  arrangement,  only 
side  distances  on  one  side  are  essentially  sensed.  For  the  row  guid¬ 
ance  control,  the  robot  is  only  permitted  to  drive  forward.  The  de¬ 
sired  location  of  the  robot  is  set  to  y  =  0  and  9  =  0.  Therefore, 
under  conditions: 

-harvesting  robot  180  cm  wide, 

-cultivation  bed  100  cm  wide  at  the  bottom, 

-interval  space  between  beds  80  cm, 

-free  space  between  wheels  is  160  cm  wide, 

-swivel  radius  of  rear  casters  is  15  cm. 

The  reference  side  distance  is  set  Sref  =  30  cm  with  a  sufficient 
margin  for  rear  casters.  The  rest  free  region  for  the  robot  in  lateral 
direction  is  Sref  ±15  cm.  Since  the  robot  is  only  permitted  to  drive 
forward,  it  cannot  proceed  with  some  special  initial  positions  like 
Sfb  =  45  cm  and  S“' b  =  45  cm  or  Slb  =  15  cm  and  Slb  =  1 5  cm.  These 
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Fig.  1.  Description  of  the  robot  position  with  respect  to  cultivation  beds  in  field  ((a)  top  view  (b)  side  view). 


situations  are  excluded  by  shrinking  the  permitted  region  of  Sf  by 
5  cm.  In  conclusion,  the  constraints  on  Sf  and  Sr  are: 

20  cm  ^  ^  40  cm  (5) 

15  cm  ^  S,  ^  45  cm  (6) 


4.  Time-optimal  control  of  row  guidance  system 

The  state  equations  of  dynamics  model  are  formulated  based  on 
the  kinematics  of  the  differential-drive  mobile  machine.  The  aim  of 
the  time-optimal  row  guidance  control  is  to  find  a  control  law  that 
minimizes  the  converging  time. 

4.1.  Problem  formulation  of  guidance  time-optimal  control 

In  the  robot  moving  frame  shown  in  Fig.  2,  the  positions  of  the 
front  and  rear  ultrasonic  sensors  are  described  by  vector  rf  and  rr 
as  follows: 

(7) 

where  La  is  the  length  of  the  robot  platform.  With  help  of  the  trans¬ 
formation  matrix  T  from  the  moving  frame  to  the  initial  frame,  the 
linear  velocity  vector  v  and  angular  speed  vector  H: 


/  cosO  -sinO  0  \ 

T  =  sine  cosO  0 
V  o  01/ 

t‘(3  n=(: 

The  velocity  of  the  sensors  SF  and  SR  can  be  derived  by: 

(vcosO  +  co  ^  cosO  \ 
vsine  +  co^sine 


(8) 

(9) 


(10) 


(vcose  +  to  y  cose  +  coLasine  \ 
vsine  +  co^sine  -  coLacose  (H) 


In  this  application,  only  the  movement  in  lateral  direction  is  consid¬ 
ered.  By  referencing  Eqs.  (10)  and  (11)  the  dynamics  of  in  lateral 
direction  are  expressed: 

SFy  =  vsine  +  co^-sine  (12) 


SRy  =  vsine  +  co^-sine  -  coLacose 


(13) 


where  Spy  and  SRy  are  the  lateral  components  of  SF  and  SR.  According 
to  the  geometric  relations  illustrated  in  Fig.  2,  the  guidance  error  of 
the  machine  at  the  reference  point  P  can  be  expressed  using  Sf  and 
Sr  as: 

eg  =  arctan^r  (14) 

Ca 


ey  =  es  +  sign(es)  ^  (1  -  cosd)  (15) 

where  Sf  =  ||Sf||  and  5r  =  ||SF||,  es  =  Sfcose  -  Sref  is  the  current  lateral 
offset  of  the  ultrasonic  sensor  SF,  and  Sref  is  the  desired  side  distance 
of  the  sensors  SF  and  SR  where  ey  =  0  and  ee  =  0. 

The  assignment  of  the  time-optimal  control  is  to  find  a  con¬ 
trol  law  of  for  transferring  the  system  described  by  Eqs.  (12) 
and  (13)  from  an  allowable  initial  state  (SFy(t0),  (to))  to  the 

final  state  (SFy(tf)  =  Sref,  SRy(tf)  =  Sref)  in  minimum  time  with 
constraints  in  Eqs.  (5)  and  (6).  The  cost  function  is  to  minimize 
the  final  time  tf: 


side  distance  [cm]  Lateral  offset  [cm]  side  distance  [cm]  Lateral  offset  [cm] 
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(a) 


(b) 


Fig.  3.  Simulation  results  of  minimum  time-optimal  control  ((a)  SFy(t0)  =  40  cm, 
SRy(to)  =  45  cm;  (b)  SFy(t0 )  -  35  cm,  SRy(t0 )  =  25  cm). 


flS 

J=  dt  (16) 

Jt0 

The  admissible  control  is  constrained  by: 

\co\  <  0.525  rad/s  (17) 


4.2.  Simulation  results 

The  minimum  time  problem  described  by  equations  from  Eqs. 
(12)-(17)  is  solved  using  General  Pseudospectral  Optimization 
Software  (GPOPS)  (Rao  et  al.,  2011),  which  is  an  open-source  soft¬ 
ware  of  optimal  control  written  in  MATLAB  environment.  GPOPS 
implements  the  Gauss  and  Radau  hp-adaptive  pseudospectral  col¬ 
location  methods  and  has  a  build-in  forward  mode  automatic  dif¬ 
ferentiation  and  generates  derivative  estimates  as  efficiently  as 
possible  by  adopting  sparse  finite-differencing  of  optimal  control 
problem.  The  continuous-time  optimal  control  problem  is  tran¬ 
scribed  to  a  finite-dimensional  nonlinear  programming  problem 
(NLP)  that  is  solved  using  a  restricted  version  of  the  NLP  solver 
SNOPT  (Gill  et  al.,  2005). 

The  time-optimal  control  of  row  guidance  system  with  con¬ 
straints  was  solved  using  MATLAB.  The  forward  velocity  of  the  ro¬ 
bot  was  set  to  12  cm/s.  The  symmetries  of  the  geometric  trajectory 
was  summarized  by  Balkcom  and  Mason  (2000).  Therefore,  only 
the  results  of  two  representative  cases  were  displayed  in  Fig.  3. 
For  the  first  case,  the  machine  started  with  an  initial  location  of 
(Spy (t0)  =  40  cm,  SRy(t0)  =  45  cm)  for  ey(t0 )  >  0,  e0(to)  >  0,  for  the 
second  case,  the  robot  starts  at  {SFy(t0)  =  35  cm,  SRy(t0)  =  25  cm) 
ey{t0)  >  0,  e0(to)  <  0. 

For  the  first  case,  it  is  observed  from  the  side  distance  plot  that 
SFy  declines  continuously  to  the  desired  value  Sref  ,  while  SRy  is  kept 
at  its  upper  bound  before  SFy  approximates  its  desired  value  Sref. 
Thereafter,  SRy  declines  drastically  to  the  desired  value  Sref.  The 
guidance  error  plot  shows  that  the  developing  process  of  ey  is  iden¬ 
tical  with  that  of  SFy.  The  heading  angle  increases  with  the  contin¬ 
uous  reduction  of  SFy  and  a  constant  SRy,  and  decreases  at  the  end  of 
process  with  dramatic  decline  of  SRy.  For  the  second  case  in  Fig.  3, 
the  robot  starts  with  ey(t0)  >  0  while  e0(to)  <  0,  where  ey  and  e0  are 
contrary  in  sign.  It  means  that  the  robot  faces  an  incorrect  direction 
as  it  starts  up.  The  side  distance  plot  illustrates  that  SRy  increases 
firstly  to  orientate  the  machine.  SFy  increases  a  bit  at  the  beginning 
before  SRy  reaches  SFy,  which  is  named  here  orientation  stage.  After 
that,  the  developing  tendency  is  the  same  as  that  by  the  first  case. 
In  the  guidance  error  plot,  e0  is  observed  to  rise  rapidly  at  the  first 
orientation  stage.  To  sum  up,  all  the  initial  errors  were  successfully 
eliminated  and  the  system  converged  to  the  desired  trajectory. 


Fig.  4.  Cascade  substitute  row  guidance  system  for  time-optimal  control. 
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Table  1 

Simulation  and  experimental  parameters. 


Parameter  Value 

Wheel  radius  r  (m)  0.3 

Gear  ratio  g  (-)  16:1 

Vehicle  width  Lb  (m)  2.1 

Supply  voltage  u(V)  24 

Motor  inertia  Jm  (kg  m2)  0.0738 

Motor  inductance  Lm(H)  \  x  10-4 

Viscous  friction  coefficient  Bm  (N  m  s  rad'1)  4  3  x  10-3 

Back-emf  constant  I<e  (V  s  rad-1)  0.45 

Torque  constant  I<m  (N  m  A-1)  0.45 

Simplified  gain  motor  closed-loop  speed  controller  kms  (-)  1 

Simplified  time  constant  motor  closed-loop  speed  controller  Tms  (s)  0.137 

Proportional  gain  orientation  controller  kp0  (s-1)  204 

Proportional  gain  lateral  controller  kky  (rad  m-1)  10 

Integral  gain  lateral  controller  kdy  (rad  m-1)  3 


From  the  simulation  results,  the  rear  side  distance  SRy  of  the 
time-optimal  control  solution  was  kept  at  its  upper  bound  for 
ey(t0)  >  0  wherever  the  robot  starts  up.  As  the  robot  and  the  drive 
motors  are  only  permitted  to  drive  forward,  there  are  some  infea¬ 
sible  initial  positions  which  the  robot  cannot  start  with  by  this 
time-optimal  process,  such  like  (SFy(t0)  =  40  cm,  SRy(t0)  <  40  cm), 
vice  versa  due  to  the  spatial  symmetry 
(Sfy(t0)  =  20  cm,  SRy(to)  >  20  cm).  For  such  infeasible  positions, 
the  signs  of  ey(t0)  and  ee(t0)  are  contrary,  and  ey(t0)  is  at  its  upper 
or  lower  boundary.  There  is  no  region  available  for  ey  at  the  upper 
boundary  to  rise  and  for  ey  at  the  lower  boundary  to  decrease  at  the 
orientation  stage  to  correct  the  heading  direction.  Those  infeasible 
positions  should  be  avoided  in  the  simulation  studies  of  the  time- 
optimal  operations.  This  problem  will  be  discussed  and  solved  in 
the  following  practical  design  in  Section  5. 

5.  Practical  substitute  system  for  time-optimal  row  guidance 
control 

As  discussed  in  Section  4,  our  guidance  system  is  governed  by  a 
set  of  nonlinear  state  equations  and  furthermore  the  original  time 
optimal  control  problem  is  subject  to  various  constraints,  such  as 
initial  and  target  conditions,  state  and  control  input  constraints. 
Thus,  it  is  difficult  to  get  the  analytical  solution.  As  a  result,  the 
numerical  solution  method  was  used  in  this  work.  The  well-devel¬ 
oped  optimal  control  software  GPOPS,  which  integrates  a  third- 
party  solver  SNOPT.  By  using  GPOPS,  the  original  time-optimal 
control  of  the  guidance  system  is  converted  into  a  large-scale  con¬ 
strained  nonlinear  programming  problem.  We  note  that  imple¬ 
mentation  of  such  complex  optimization  algorithm  in  a  typical 
low-cost  hardware  for  our  agricultural  machine  is  unrealistic.  This 
is  because  the  available  micro-controller  system  like  PSoC  5  offers 
very  limited  memories  and  the  clock  frequency  of  the  CPU  is  in  the 
MHz  range.  All  the  aspects  motivate  us  to  explore  computational 
cost-effective  solutions.  At  the  same  time,  we  notice  that  there  is 
a  mapping  of  side  distances  (S/,Sr)  onto  guidance  error  (ey,  e0 ) 
accordingly  to  Eqs.  (14)  and  (15).  Enlightened  by  the  simulation  re¬ 
sults  of  the  time-optimal  control  in  Section  4,  we  seek  an  compa¬ 
rable  solution  by  improving  the  cascade  guidance  system 
suggested  in  Dong  et  al.  (2011). 

The  cascade  controller  consists  of  two-level  structure  shown  in 
Fig.  4.  Two  independent  speed  loops  at  the  low  level  are  designed 
to  stabilize  the  angular  speeds  of  drive  motors.  A  cascade  structure, 
consisting  of  orientation  inner  loop  and  lateral  offset  outer  loop, 
was  adopted  at  the  high  level  to  get  rid  of  the  following  deviation 
from  the  target  row.  As  a  prior  try,  the  heading  angle  of  the  inner 
loop  was  simply  constrained  by  setting  a  constant  limitation  to 
the  output  of  lateral  offset  controller  in  the  outer  loop.  For  the 


cascade  guidance  system  in  Fig.  4,  the  forward  velocity  vref  is 
preset.  comre/  =  vrefg/r  is  the  equivalent  angular  speed  of  the  drive 
motors  with  g  the  gear  ratio  and  r  radius  of  the  drive  wheel.  comdiff 
is  the  differential  angular  speed  between  the  drive  motors  that  is 
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Fig.  5.  Comparison  simulation  results  ((a)  SFy(t0)  =  40  cm,  SRy(t0)  =  45  cm;  (b) 
SFy(t0 )  =  35  cm,  SRy(t0 )  =  25  cm). 
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given  by  the  orientation  angle  controller.  Here  comdiff  is  equivalent 
to  the  time-optimal  control  variable  co  in  Section  4.  The  desired 
angular  speeds  of  the  drive  motors  co*ml  and  co*mr  are  obtained 
through: 

mdiff 


tO mi  —  riJmref 


60mr  —  OJmref  + 


2 

tO mdiff 


(18) 


(19) 


Differently  from  the  time-optimal  control  discussed  in  Section  4, 
where  the  state  variables  are  front  and  rear  side  distances  SFy  and 
$Ry,  the  controlled  variables  of  the  substitute  controller  are  ey  and 
ee.  In  order  to  prevent  any  collision  between  the  field  robot  and  cul¬ 
tivation  beds,  not  only  the  lateral  offset  ey,  but  also  the  heading  an¬ 
gle  of  the  machine  ee  must  be  efficiently  constrained  during 
operation.  It  is  observed  from  the  simulation  results  in  Fig.  3  that 
there  is  no  constant  limitation  to  e9,  which  varies  with  the  actual 
front  side  distance  Sfy.  The  lower  and  upper  bounds  of  heading  an¬ 
gle,  6lb  and  6ub,  can  be  accordingly  expressed  by: 
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Fig.  6.  Simulation  results  of  critical  situations  ((a)  SFy(t0)  =  40  cm,  SRy(t  0)  =  15  cm; 
(b)  SFy(t0 )  =  20  cm,  SRy(t0)  =  45  cm). 
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eub  =  sign(es)  arctan  r  ~  r  (21 ) 

Eq 

All  the  controllers  including  speed  controllers  of  drive  motors,  lateral 
offset  controller  and  orientation  controller  in  this  substitute  system 
were  designed  using  PID  algorithms  based  on  the  kinematic  model 
of  the  differential  drive  mobile  robot.  It  was  demonstrated  in  detail 
in  Dong  et  al.  (2011).  The  main  parameters  were  given  in  Table  1. 

5.1.  Simulation  results  and  discussion 

To  allow  for  a  fair  comparison  between  the  substitute  and  the 
time-optimal  controller,  the  same  initial  locations  were  applied. 
The  comparison  simulation  results  are  shown  in  Fig.  5.  It  is  illus¬ 
trated  that  the  simulation  plots  superpose  with  each  other  quite 
well.  The  only  minor  difference  between  the  two  systems  is  the 
development  of  SRy  from  its  upper  bound  to  the  desired  value.  It 
is  also  observed  by  ee.  It  can  be  easily  explained  with  the  cascade 
control  structure.  Differently  from  the  numerical  solution  of 
time-optimal  control,  the  outer  loop  of  the  cascade  controller  is 
kept  saturated  to  allow  the  lateral  offset  ey  to  fall  as  soon  as  possi¬ 
ble.  e6  begins  to  fall  only  when  the  outer  loop  of  lateral  offset  re¬ 
treats  from  saturation. 

As  discussed  in  Section  4,  for  the  time-optimal  design  the 
machine  cannot  start  up  from  such  initial  locations  as  ( SFy(t0 )  = 
40  cm,  SRy(t0)  <  40  cm)  or  ( SFy(t0 )  =  20  cm,  SRy(t0)  >  20  cm) 
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Fig.  7.  Experimental  platform  ((a)  Setup:  1.  Laptop,  2.  Joystick,  3.  Sabertooth,  4. 
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Model  of  cultivation  bed;  (b)  schematic  illustration  of  row  guidance  control 
system). 
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because  the  constraint  on  SFy  must  be  tightly  held  in  solving  the 
time-optimal  control  problem.  This  problem  was  solved  in  the  cas¬ 
cade  substitute  system.  The  simulation  results  with  two  critical 
initial  positions,  where  SFy(t0)  =  40  cm,  SRy(t0)  =  15  cm  and 
Spy (t0 )  =  20  cm,  Spy (t0)  =  45  cm,  were  shown  in  Fig.  6.  In  Fig.  6(a) 
to  get  rid  of  the  initial  errors  the  robot  is  required  to  orientate  itself 
firstly,  which  causes  increase  in  front  side  distance  and  results  in 
exceeding  the  soft  constraints  imposed  on  SFy  by  2  cm.  The  plots 
in  Fig.  6(b)  show  the  symmetrical  results.  It  is  completely  accept¬ 
able  according  to  the  original  constraints  Sref  ±15  cm. 

It  is  concluded  that  the  improved  substitute  controller  fulfill  the 
guidance  objective  of  the  time-optimal  system  successfully  by 
properly  setting  constraints  to  the  desired  heading  angle.  The  con¬ 
troller  based  on  PID  method  economizes  expensive  computation 
costs.  Moreover,  the  startup  problem  with  critical  initial  positions 
was  also  solved  with  the  cascade  guidance  system.  Therefore,  the 
substitute  design  is  preferable  and  practical  to  be  implemented 
on  micro-processor.  Consequently,  we  put  only  the  cascade  substi¬ 
tute  system  in  practice  on  the  experimental  platform. 
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5.2.  Experimental  results  in  laboratory 

The  experimental  setup  were  shown  in  Fig.  7.  The  control  loops 
at  low  level  were  performed  with  a  frequency  of  200  Hz.  The  cas¬ 
cade  system  at  the  high  level  worked  with  a  frequency  of  20  Hz. 
The  forward  linear  velocity  of  the  machine  is  set  to  12  cm/s.  The 
processing  data  were  saved  on  a  computer  through  USB  cable. 
The  guidance  performance  was  investigated  against  varied  initial 
positions  and  lateral  offset.  Each  experiment  was  executed  repeat¬ 
edly,  and  the  similar  results  were  achieved.  The  two  representative 
experimental  results  were  illustrated  in  Fig.  8. 

For  the  first  study,  the  robot  started  with  an  initial  position  of 
(SFy(t0)  =  38.8  cm,  Sty (t0)  =  44  cm),  which  is  comparable  with  the 
simulation  case  in  Fig.  5.  To  evaluate  the  guidance  performance 
against  external  disturbance,  a  lateral  offset  of  about  1.5  cm  was 
introduced  at  about  t  =  60  s.  The  experimental  results  coincided 
quite  well  with  the  simulation  results  in  Fig.  5.  The  converging  pro¬ 
cess  of  this  experimental  case  is  about  10  s  shorter  than  the  simu¬ 
lation  results  of  the  first  case  study  in  Fig.  5  due  to  the  smaller 
initial  lateral  offset.  Fig.  8(b)  shows  the  experimental  results  where 
the  robot  started  with  (SFy(t0)  =  33.5  cm,  5ty(t0)  =  28  cm).  SFy  con¬ 
verges  to  the  desired  value  before  •Sty  reaches  its  upper  bound.  In 
both  cases,  the  experimental  results  coincide  closely  with  those 
of  the  numerical  studies.  The  only  difference  of  the  experimental 
results  from  the  numerical  ones  is  that  SRy  (or  e6)  fluctuates  contin¬ 
uously  around  its  desired  value  in  that  ey  is  not  strictly  kept  at  its 
desired  value  in  the  experimental  tests,  and  the  adjustment  of  the 
following  error  is  only  realized  by  modifying  SRy  (or  e6).  Altogether, 
all  the  initial  error  and  the  introduced  disturbance  were  success¬ 
fully  eliminated  with  the  proposed  practical  guidance  system.  A 
following  precision  of  ±0.5  cm  for  the  reference  point  P  of  the  ro¬ 
bot  was  achieved. 


5.3.  Verification  in  field 

The  field  robot  with  the  proposed  cascade  row  guidance  strat¬ 
egy  was  put  in  real  cultivation  field  of  white  asparagus  to  investi¬ 
gate  the  following  operation  under  the  situations  (see  Fig.  9).  The 
experiments  were  carried  out  at  later  season  of  white  asparagus. 
The  cultivation  bed  was  considerably  out  of  shape  with  time  lapse 
and  weeds.  The  sandy  ground  surface  was  rather  soft  due  to 
drought.  The  test  results  are  illustrated  in  Fig.  10.  The  forward 
velocity  varied  from  minimal  12  cm/s  (see  Fig.  10(a))  to  maximal 
50  cm/s  with  a  load  of  80  kg  (Fig.  10(b)).  The  measuring  noise 
was  caused  by  roughness  of  the  sandy  and  weedy  side  surface  of 
the  cultivation  bed.  The  initial  errors  were  efficiently  compensated 
with  the  practical  substitute  controller.  The  robot  succeeds  in 


Fig.  8.  Experimental  results  in  laboratory  ((a)  SFy(t0 )  =  38.8  cm,  SRy(t0 )  =  44  cm; 
(b)  Sfy(to)  =  33.5  cm,  SRy(t0 )  =  28  cm). 


Fig.  9.  On-site  investigation  in  field. 
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Fig.  10.  Experimental  results  in  field  ((a)  SFy(t0)  =  28  cm,  SRy(t0)  =  40  cm, 
vref  =  12  cm/s;  (b)  SFy(t0)  =  22.7  cm,  SRy(t0 )  =  27.8  cm,  vref  =  50  cm/s). 

driving  along  the  target  row  against  external  disturbance  in  field.  It 
is  shown  that  the  practical  row  guidance  system  works  quite  well 
and  a  following  precision  of  roughly  ±3  cm  for  ey  has  been 
achieved  under  the  on-site  situations. 

6.  Conclusion 

Under  consideration  of  the  cultivation  features,  the  time-opti¬ 
mal  guidance  control  problem  has  been  formulated  based  on  the 
kinematics  model  of  the  differential  drive  wheeled  mobile  robot. 
The  intra-row  position  was  expressed  using  the  front  and  rear  dis¬ 
tances  measured  by  ultrasonic  sensors.  Subsequently,  the  time- 
optimal  control  problem  was  numerically  solved  using  the  open 


source  optimal  control  software  GPOPS.  Based  on  the  analysis  of 
the  numerical  results  of  the  time-optimal  control,  a  cascade  con¬ 
troller  based  on  PID  method  was  improved  as  a  practical  substitute 
to  perform  time-optimal  control  performance.  By  properly  adjust¬ 
ing  the  constraints  to  the  heading  angle  in  the  inner  loop  of  cas¬ 
cade  controller  at  the  high  level,  the  substitute  successfully 
accomplished  the  tasks  of  the  time-optimal  control.  Since  the  sub¬ 
stitute  was  designed  based  PID  algorithm,  the  complex  nonlinear 
optimization  problem  that  is  essential  in  solving  time-optimal  con¬ 
trol  program  was  avoided.  The  practical  cascade  system  not  only 
improves  the  computing  efficiency  in  the  simulation  studies,  but 
also  allows  for  an  effortless  implementation  on  the  PSoC  5  based 
hardware  platform.  The  efficiency  of  the  proposed  row  guidance 
strategy  has  been  thoroughly  investigated.  A  satisfying  guidance 
performance  with  a  precision  of  ±3  cm  has  been  achieved  in  the 
field  test. 

Our  future  work  will  focus  upon  integration  of  the  platform 
with  cascade  row  guidance  system  with  the  harvesting  apparatus, 
aiming  at  constructing  a  prototype  of  an  autonomous  machine  for 
white  asparagus  harvesting.  With  more  investment  an  autono¬ 
mous  navigation  guidance  with  help  of  RTK  GPS  for  the  harvesting 
robot  would  be  further  investigated. 
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